package websocket.util;

import java.math.BigDecimal;

/**
 * @ClassName MathUtil
 * @Des TODO
 * @Author lg
 * @Date 2022/6/24 11:56
 * @Version 1.0.0
 **/
public class MathUtil {

    private final static int precision = 8; // 转换后保留精度

    private static final double EARTH_RADIUS = 6378137.0;

    /**
     * double类型数字保留数字精度
     *
     * @param number 带转换数字
     * @return
     */
    public static double formatDouble(double number) {
        BigDecimal bg = new BigDecimal(number).setScale(precision, BigDecimal.ROUND_DOWN);
        return bg.doubleValue();
    }

    /**
     * 两经纬度之间的水平距离
     *
     * @param lat1
     * @param lng1
     * @param lat2
     * @param lng2
     * @return
     */
    public static double calHorizontalDistance(double lat1, double lng1, double lat2, double lng2) {
        double radLat1 = rad(lat1);
        double radLat2 = rad(lat2);
        double a = radLat1 - radLat2;
        double b = rad(lng1) - rad(lng2);
        double s = EARTH_RADIUS * 2 * Math.asin(Math.sqrt(Math.pow(Math.sin(a / 2), 2) +
                Math.cos(radLat1) * Math.cos(radLat2) * Math.pow(Math.sin(b / 2), 2)));
        return s;
    }

    /**
     * 两经纬度之间的斜距
     *
     * @param lat1
     * @param lng1
     * @param lat2
     * @param lng2
     * @param height 两经纬点的高度差
     * @return
     */
    public static double calObliqueDistance(double lat1, double lng1, double lat2, double lng2, double height) {
        double horizontalDistance = calHorizontalDistance(lat1, lng1, lat2, lng2);
        double s = Math.sqrt(horizontalDistance * horizontalDistance + height * height);
        return s;
    }

    /**
     * 两经纬度之间的俯仰角
     *
     * @param lat1
     * @param lng1
     * @param lat2
     * @param lng2
     * @param height 两经纬点的高度差
     * @return
     */
    public static double calObliqueAngle(double lat1, double lng1, double lat2, double lng2, double height) {
        double horizontalDistance = calHorizontalDistance(lat1, lng1, lat2, lng2);
        double s = Math.atan(height / horizontalDistance);
        return s;
    }

    private static double rad(double d) {
        return d * Math.PI / 180.0;
    }

    
}
